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(57) Abstract: This invention relates to the field of Incrtial Navigation Systems (INS) and satellite navigation systems such as the 
O Global Positioning System (GPS) and in particular relates to methods of integrating GPS and INS data in order to provide more 
£^ accurate navigation solutions. The invention provides a method of improving the accuracy of a tightly coupled integrated INS and 
^ satellite radio navigation system in cases where the satellite navigation receiver has adaptive tracking loop hand widths. 
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Adaptive GPS and INS Integration System 

This invention relates to the field of Inertia! Navigation Systems (INS) and satellite 
positioning systems such as the Global Positioning System (GPS). In particular, this 
invention jslates to methods of integratingJNS andLGPS .data in order to proyide more . 

3CCT^ tf ^T^3Ogatt0nS0iUtlODS^ 

An INS comprises a set of accelerometers and gyroscopes, known as an inertial 
measurement unit (IMU), together with a navigation equations processor, which 
integrates the IMU outputs to give the position, velocity and attitude. GPS consists of 
a constellation of satellites which transmit navigation data to a GPS receiver. User 
location can be derived from the signals received from four separate satellites. 
Together, INS and GPS form the core navigation systems of military aircraft and 
missiles. Note: although the term "GPS" is used throughout the skilled man will 
-gppreaatSTft^^ to toy satellite navigation system that works along 

similar principles to GPS, e.g/ Galileo. References to GPS should therefore be taken as 
meaning any satellite system that operates in a GPS-like manner. 

Integrating INS and GPS together provides a navigation solution which combines the 
long term accuracy of GPS with the continuity, high bandwidth and low noise of INS. 

There are four basic types of INS/GPS integration technique. An uncoupled system 
simply uses the GPS data to periodically reset the INS. This approach is crude and, 
hence, is rarely used. A loosely-coupled system compares the GPS navigation solution 
to that of the INS to estimate errors in both systems using a Kahnan filter based 
algorithm (for more information on the Kahnan filter algorithm see Applied Optimal 
Estimation by The Technical Staff of the Analytical Sciences Corporation, editor A 
Gelb, Massachusetts Institute of Technology Press (1974)) . A tightly-coupled system, 
is similar to the loosely-coupled system but uses the range and range rate data 
transmitted from each satellite tracked instead of the GPS navigation solution. Finally, 
a deep integration system combines the GPS receiver tracking functions and INS/GPS 
integration within a common Kahnan filter. This requires the re-design o£ amongst 
other things, the GPS receiver, which requires access to the GPS Receiver 
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Applications Module (GRAM), which is restricted by the US Government. Processor 
loads in a deep integration system are also high and so this system has a number of 
drawbacks. 

Both loosely-coupled- and iightly-coupled -systems* are in common user-However, 




invention (for further information on GPS/INS integration see GPS/INS Integration, 
AGARD Lecture Series LS-207; Systems Implications and Innovative Applications of 
Satellite Navigation by R B Phillips and G T Schmidt). 

Each navigation satellite transmits earner signals on two frequencies, known as LI 
and L2» each with a pseudo-random code modulated onto it The GPS receiver will . 
trade t^e code and carrier components of each signal independently. Each receiver will 
therefore maintain two so-called tracking loops for each satellite signal Range data 
(referred to as "pseudo-range" in GPS terminology) is derived from the code signal 
tracking loop and range-rate data (referred to as "pseudo-range rate 9 *) is derived from 
the carrier signal tracking loop. In normal GPS operation, each carrier tracking loop is 
used to aid the corresponding code tracking loops. However, carrier tracking loops are 
more sensitive to interference and will lose lock at lower interference levels than code 
tracking loops. The position of the receiver can be derived from the pseudo-range 
information and the velocity of the receiver can be derived from the pseudo-range rate 
information. 

The responsiveness of a GPS receiver is affected by noise (eg. from interference with 
die GPS signal) and also by high dynamic vehicle manoeuvres. The bandwidth of the 
tracking loops is a measure of the frequency with which the receiver outputs 
independent range and range rate measurements. High bandwidths enable a receiver to 
track the receiver location more quickly whereas low bandwidths provide greater 
resistance to interference. It is thus important to select bandwidths carefully in order to 
marntmn satisfactory receiver performance. 



SUBSTITUTE SHEET (RULE 26) 

BHSDOCH* «WQ p1fiue71A1J_> 



WO 01/94971 



PCT/CB01/02307 



3 

In the military environment many GPS receivers are capable of adapting their tracking 
loop bandwidths in order to respond to changes in the level of vehicle motion and 
interference. 

In an integrated INS/GPS-(tightly TOupled)-system the-pseudo-range and pseudoronge 




filter. In dual frequency receivers, the outputs from the LI and L2 tracking channels 
are combined prior to input to the Kahnan filter in order to correct for ionosphere 
propagation delays. A reversionary mode is usually implemented whereby INS data 
aids the code tracking loop in the event that the carrier tracking loop loses lock and the 
GPS receiver is unable to derive range-rate data. 



The Kahnan filter is an estimation technique which provides an estimate of the 
GPS/INS system errors. Part of the Kahnan filter technique is the calculation of die so- 
called Kahnan gain matrix (Kj)~whicli relates the accuracy of the current measurement 
to that of the previous estimates of the system errors. In order to correctly calculate the 
measurement errors in the system the Kahnan filter assumes that all measurements 
have time uncorrelated measurement errors. Gelb defines die Kalman gain matrix (Kj) 

* Ku « P* (-)Hl [HAi^G-^I+Rj where H* is the measurement 
matrix, R* is the measurement noise covariance and 0~ l denotes the inverse of the 
matrix. 

In feet the errors in successive pseudo-range and pseudo range-rate data are correlated 
with correlation times inversely proportional to the tracking loop bandwidths. If this 
feet is not addressed then die Kalman filter becomes unstable, resulting in degraded 
estimates. Where the Kalman filter corrected INS data is used to aid GPS code 
tracking, a form of positive feedback can occur which eventually causes the GPS 
receiver to lose its tracking locks. The navigation solution cannot be resurrected from 
the INS data alone, where die corrected INS data is used to aid GPS, either because 
there is no stand alone INS solution or because the INS solution, if available, is not 
accurate enough. Therefore, where GPS receivers that do not have adaptive 
bandwidths are used, this problem is circumvented by ensuring that the Kalman filter 
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updates its estimate of the measurement errors at an interval which is greater than the 
tracking loop measurement correlation time (of the order of.l second), i.e. the interval 
between iterations of the Kalman filter measurement update phase is chosen to be 
greater than the tracking loop measurement correlation time. Since different receivers 




Kalman filter is correctly tuned to the appropriate tracking loop bandwidths. 



In cases where the receiver has adaptive tracking loop bandwidths tuning of the 
integration algorithm becomes more difficult A common approach is to tune the 
algorithm to a relatively high bandwidth level and disable the Kalman filter 
measurement inputs when the tracking loop bandwidth drops below a threshold value. 
This is obviously not an ideal solution since measurement data is being discarded 
which will inevitably result in a less than optimum navigation solution. 

It is therefore an object of the present invention to provide a method of improving the 
accuracy of a tightly coupled integrated INS and satellite radio navigation system and 
to alleviate the above mentioned problems. 

Accordingly this invention provides a method of integrating ineitial navigation system 
and satellite navigation system data in a tightly coupled architecture by means of a 
Kalman filter, the satellite navigation data being received on a receiver having 
adaptive tracking loop bandwidths, comprising 

i) monitoring the tracking loop bandwidths or modelling them as a 
function of the receiver measured signal to noise density ratio (c/oo) 
outputs , and 

ii) varying die rate of response of the Kalman filter to measurements from 
the satellite navigation system in response to changes in the tracking 
loop bandwidths such that correlated measurement noise in the Kalman 
filter is avoided. 

It should be noted that the bandwidths of die tracking loops for different satellites are 
likely to vary independently of one another, particularly where a controlled radiation 
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pattern antenna (CRPA) is used Therefore, the adaptive initial/satellite navigation 
system integration algorithm should be enable of adapting the Kahnan filter for each 
tracking loop. 

Where thrtracldng'loop bandwidths are not' a direct output of the sateffite receiver 
tfiey may be inieuaf fioxu die leceivei measured siguallu laoiaTdeUsa t y raU^(c/uby/ 
The variation of the tracking loop bandwidth with measured (c/no) is different for each 
receiver design. It is therefore necessary either to obtain the information from the 
manufacturer or to infer it from laboratory testing of the receiver using a GPS signal 
simulator capable of generating interference. 

By adapting the Kahnan filter to the tracking loop bandwidth the best use of the 
satellite data is made. There are a number of ways in which the filter can be adapted 

The update- interval (iteration rate) ol the J&alman- niter can -De varied. Below a" 
threshold bandwidth the interval between measurement updates from each tracking 
channel is varied in inverse proportion to the tracking channel bandwidth. Therefore 
for low bandwidths the iteration rate of the filter can be reduced. As an alternative to 
this the measurement data can be averaged over the iteration interval provided the 
averaged measurement is treated as a single measurement for statistical purposes. 

Alternatively, the Kahnan gain matrix can be weighted down in order to obtain a rate 
of response of Kahnan filter estimates to measurements equivalent to that obtained by 
increasing die measurement update interval. In this variation of the invention the 
measurement update interval remains fixed for each measurement type - pseudo-range 
and pseudo range-rate. When the tracking loop bandwidth drops below a threshold 
value, to which the update interval is tuned, the Kahnan gain matrix is weighted down 
to simulate increasing die measurement update interval. 

The weighting of the Kahnan gain matrix can conveniently be achieved by multiplying 
it by the time between successive (correlated) measurements divided by die time 
between successive un-correlated measurements. 



BNSOCQD: <WO 01&4&7iAlJ_> 



SUBSTITUTE SHEET (RULE 26) 



WO 01/94971 



PCT/GB01/U2307 



6 

Weighting of the gain matrix can also be achieved by multiplying it by a suitable 
adaption matrix. If the Kalman gain matrix is represented as one n, column matrix for 
pseudo-range measurements and a second n* column matrix for pseudo-range rate 
measurements, where n* is the number of satellites tracked, then each adaption 
matrix A is on Xh x n, diagonal matrix wfaerria- 

i) for the elements of the pseudo-range adaption matrix 

Apkn^l for Bi^ocm>Bl.cot 

Apkii ° Blcoi/Blcot for B L _cof < B l _cot 

where Bljx» is the code tracking bandwidth of tracking channel 
i and Blcot is the threshold code tracking bandwidth for 

ii) for the elements of the pseudo-range rate adaption matrix 

Aaca = 1 for Bi^cai ^ Bljcat 

Aab 83 Bl_ca/Bl_cat for Bl_caj < B^cat 

where Bl_cai is the carrier tracking bandwidth of tracking 
channel / and Bljcat is die threshold carrier tracking bandwidth 
for adaption, 

A further way of adapting the Kalman filter is to vary the measurement noise 
covariance, R, which is a quantity that is varied within the Kalman gain matrix. Either 
this can be done by multiplying it by the time between successive un-correlated 
measurements divided by the time between successive (correlated) measurements or 
by dividing by an adaption matrix analogous to that described above. In the latter case, 
this involves replacing R within the Kalman gain matrix, K* with R* where R*=R/A. 
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An additional way of adapting the Kalman filter is to model the time correlated 
measurement noise explicitly, either as additional Kalman filter states or as correlated 
measurement noise using a Schmidt-Kalman filter with Uncertain parameters (for 
more information on the Schmidt-Kalman filter algorithm see Stochastic Processes 



the correlated measurement noise estimate, x, is modelled as a first order Markov 
process, i.e. 



dx_ x 

*- 

where the correlation time, should be modelled as inversely proportional to the 
tracking loop bandwidfhs. 



fe-me 

navigation data according to the present invention will now be described with 
reference to Figure 1 which depicts an adaptive tightly-coupled INS/GPS integrated 
navigation system* 

Turning to Figure 1, a tightly coupled INS/GPS integrated navigation system is shown. 
A GPS receiver 1 is connected to a Kalman filter 3. An INS 5 is connected to the 
Kalman filter 3 and also the GPS receiver 1* A Kalman gam re-weighting function 9 is 
connected to both the Kalman filter 3 and the GPS receiver 1 . 

In use, the GPS receiver 1 outputs pseudo-range and pseudo-range rate measurements 
2 to the Kalman filter 3. It is assumed that these pseudo-range and pseudo-range rate 
measurements have been combined from the individual LI and L2 frequency 
measurements to correct for ionosphere propagation delays. The receiver 1 also sends 
GPS broadcast navigation data 4 to the Kalman filter 3, which enables the satellite 
positions, velocities and clock offsets to be calculated 

Hie INS 5 outputs position, velocity and attitude 6 measurements to the Kalman 
filter 3* The Kalman filter 3 (in a closed-loop architecture) sends corrections 7 back to 
the INS 5. These corrections comprise Kalman filter estimates of the INS position, 
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velocity, attitude and inertial instrument mors. The INS 5 uses these to correct its 
position, velocity and* attitude solution and to correct the outputs of its constituent 
inertial sensors! INS position, velocity and attitude 8 outputs are also sent to the GPS 
receiver 1, wh ich uses them to aid the code t racking loops of those satellite signals for 



The Kahnan filter 3 comprises a standard tightly-coupled INS/GPS integration 
algorithm, with the exception that the Kahnan gain, K, is re~weighte<L The Kahnan 
filter operates a standard system propagation (or prediction) cycle. It operates a 
standard measurement update cycle up to and including the calculation of the Kahnan 
gain matrices. A Kahnan gain re-weighting function 9 takes unweighted Kahnan gam 
matrices 10 computed by the Kahnan filter for the current set of pseudo-range 
measurements and the current set of pseudo-range rate measurements and multiplies 

weighted Kahnan gain matrices 11 which are sent to the Kahnan filter. The Kahnan 
filter 3 then resumes the measurement update cycle using the re-weighted Kahnan gain 
matrices. 

The Kahnan gain re-weighting function 9 calculates the adaptation matrices, A, using 
the formulae presented above from the tracking loop bandwidths 12 output by the GPS 
receiver 1. Where the GPS receiver does not output tracking loop bandwidths, an 
empirical model is inserted between 1 and 9 to estimate the bandwidths 12 as a 
function of the receiver output (c/ho) qieasurements. 
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Claims 

1. A method of integrating inertia! navigation system and satellite navigation system 
data in a tightly coupled architecture by means of a Kahnan filter, the satellite 
navigation ~dafarbeing~ re cejved~dg"~sr received ~ha^g~aaffitive~^ 
K a nawidtos, conip Hsmg- 

i) . monitoring the tracking loop bandwidths or modelling than as a 

function of the receiver measured signal to noise density ratio (c/ho) 
outputs , and 

» 

ii) varying the rate of response of the Kalman filter to measurements from 
the satellite navigation system in response to changes in the tracking 
loop bandwidths such that correlated measurement noise in the Kalman 

2. A method as claimed in Claim 1 wherein the Kalman filter is varied for each 
traddng loop. 

3. A method as claimed in any preceding claim wherein the tracking loop band 
widths are calculated from the received signal to noise density ratio. 

4. A method as claimed in any preceding claim wherein the iteration rate of the 
Kalman filter is varied in inverse proportion to the tracking loop bandwidth. 

5. A method as claimed in any preceding claim wherein measurement data averaged 
is averaged over the iteration period. 

5. A method as claimed any of Claims 1 to 3 wherein the Kalman gm i matrix is 
weighted by multiplying it by the time between successive measurements divided 
by the time between successive uncorrelated measurements. 

h A method as claimed in any of Claims 1 to 3 wherein the Kalman gain matrix is 
represented as one n t column matrix for pseudo-range measurements and a second 
n, column matrix for pseudo-range rate measurements, where n# is the number of 
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satellites tracked, and is then weighted by an adaption matrix A, the adaption 
matrix being an n, x n, diagonal matrix where 

i) the elements of the pseudo-range adaption matrix are 



A*a 83 Blco/Bljcot for Bljxx < Bljxtt 

where Bjjooi is the code tracking bandwidth of tracking channel 
i and Bi^cot is the threshold code tracking bandwidth for 
adaption, and; 

ii) the elements of the pseudo-range rate adaption matrix are 



Aah =* Bljca/Bl^cat for Blcaj < B Lj cat 

A*a = 0 i±j 

where B L _cAi is the earner tracking bandwidth of tracking 
channel i and B^cat is the threshold carrier tracking bandwidth 
for adaption. 

7. A method as claimed in any of Claims 1 to 3 wherein the measurement noise 
covariance, R, is divided by an adaption matrix A as claimed in claim 6. 

8. A method as claimed in any of Claims 1 to 3 wherein the measurement noise 
covariance, R, is weighted by multiplying by the time between successive 
uncoirelated measurements divided by the time between successive measurements, 

9* A method as claimed in any preceding claim wherein the satellite navigation 
system is a Global Positioning System. 

10. A method of integrating inertial navigation system and satellite navigation system 
data in a tightly coupled architecture by means of a Kalman filter, the satellite 
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navigation data being received on a receiver having adaptive tracking loop 
bandwidths, comprising 

i) monitoring the tracking loop bandwidths or modelling them as a 
fraction of tfae rec^yer merem-efl siffl^ to noise d^^1fat^(fi/DaX! 
outputs , and 

ii) modelling the correlated measurement noise within the Kalman Biter 
explicitly such that the assumed correlation time is varied in inverse 
proportion to the tracking loop bandwidths. 

11. A method as claimed in Claim 10 wherein the correlation time is varied 
independently for measurements from each tracking loop. 

= J2t = A^e&od = asrj?laimed^TM^aTm -1 (I BAg^^fe^^^m^gg^ag^g^^ge-; 
calculated from the received signal to noise density ratio. 

13. A method as claimed in Claims 10 to 12 wherein the correlated measurement noise 
is estimated as Kalman filter states. 

14. A method as claimed in Claims 10 to 12 wherein the correlated measurement noise 
is modelled using a Schmidt-Kalman filter algorithm. 
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